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This  report  was  prepared  by  William  Mikulski  and  William  E.  Shephard 
of  the  Reference  Systems  Branch,  Reconnaissance  and  Weapon  Delivery 
Division,  Air  Force  Avionics  Laboratory,  Wright-Patterson  Air  Force  Base, 
Ohio. 


The  work  was  initiated  under  Project  Work  Unit  Number  19270202. 
The  report  covers  effort  during  the  period  May  1973  to  December  1975. 
AFAL-TR-77-8,  Volume  II  contains  the  SKC-2000  computer  listing. 
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SECTION  I 


INTRODUCTION 

This  report  describes  the  conversion  of  the  computer  software 
for  a precision  inertial  navigation  from  its  first  developed  computer 
code  to  a program  for  a more  sophisticated  and  powerful  machine.  The 
inertial  navigation  system  was  the  Gimballed  Electrostatic  Gyro 
Navigation  System  (GEANS)  developed  under  AFAL  contract  by  Honeywell 
Inc.  The  GEANS  equipment  consists  of  an  Inertial  Measurement  Unit 
(IMU)  and  an  electronics  unit.  In  addition  a digital  computer  and 
associated  control  and  display  unit  are  required. 

The  GEANS  is  unusual  both  because  of  its  high  accuracy  (0.1  nm/hour) 
and  because  of  its  space  stabilized  mode  of  operation.  These  two 
features  resulted  in  the  development  of  unique  computer  software  to 
meet  the  accuracy  requirements  and  to  provide  for  the  special  problems 
of  the  alignment  of  a space  stabilized  gyro  and  accelerometer  assembly. 

The  purpose  of  the  GEANS  Software  Conversion  Project  was  to 
evaluate  the  machine  dependency  and  flexibility  of  application  of  the 
GEANS  software.  This  was  accomplished  by  implementing  the  alignment 
and  navigation  algorithms  developed  originally  for  the  Honeywell 
HDC-601  digital  computer  on  the  Singer-Kearfott  SKC~2000.  Since  the 
SKC-2000  computer  is  logically  similar  to  the  SKC-2070  which  is  used 
on  the  B-1  aircraft,  the  project  results  will  be  useful  in  the  event 
that  GEANS  is  used  as  part  of  the  B-1  avionics  equipment. 
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The  software  which  was  converted  was  that  used  for  Optimized 
GEANS  and  is  not  identical  with  the  nmre  recently  developed  SPN/GEANS 
software,  although  differences  are  minor. 

Since  it  was  desired  to  compare  the  navigation  outputs  of  the 
original  and  converted  programs  for  identical  inputs,  the  SKC-2000 
computer  was  arranged  to  operate  in  parallel  with  the  HDC-601 
computer.  It  was  therefore  not  necessary  to  convert  the  sequencing 
and  control  portions  of  the  HDC-601  program  since  the  normal  operation 
under  HDC-601  control  was  maintained. 

The  project  was  accomplished  at  the  Air  Force  Avionics  Laboratory 
(AFAL/RWA-3)  by  AFAL  personnel  using  the  facilities  of  the  Reconnaissance 
and  Weapon  Delivery  Division  Software  Evaluation  Laboratory. 
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SECTION  II 

GEANS  COMPUTATIONAL  REQUIREMENTS 

The  computational  requirements  of  the  Gimballed  Electrostatic 
Gyro  Aircraft  Navigation  System  (GEANS)  differ  significantly  from 
those  of  a conventional  local  vertical  Inertial  Navigator.  These 
differences  result  from  both  the  very  high  accuracy  required  and 
the  unique  method  of  operation  as  a space  stabilized  system. 

The  GEANS  operates  in  the  space  stabilized  mode  both  physically 
and  computationally.  Physical  space  stabilized  operation  means  that, 
after  initial  rough  platform  erection,  the  sensor  assembly  containing 
two  two-degree-of- freedom  gyros  and  three  single  axis  accelerometers 
is  not  rotated  with  respect  to  inertial  space  and  thus  the  acceler- 
ometers are  not  continuously  maintained  in  a fixed  orientation  with 
respect  to  the  earth.  Computation  is  also  in  a space  stabilized 
coordinate  frame.  This  means  that  acceleration,  velocity,  and 
position  are  computed  in  a coordinate  frame  which  does  not  rotate 
with  the  earth  and  which  is  irrotational  in  inertial  space.  Subsequent, 
subsidiary  computations  based  on  inertial  space  position  and  elapsed 
time  since  alignment  provide  position  and  velocity  in  conventional 
earth  referenced  coordinates,  i.e.,  latitude,  longitude,  altitude, 
north  velocity,  east  velocity,  and  vertical  velocity. 

The  space  stabilized  computational  frame  is  fixed  in  inertial 
space  at  the  time  of  transition  from  the  alignment  mode  to  the 
navigation  mode.  The  origin  of  this  orthogonal  frame  is  on  the 
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Earth's  Polar  Axis  (EPA)  with  the  x axis  through  the  latitude  and 
longitude  of  alignment,  the  z axis  parallel  with  the  EPA  and  y 
perpendicular  to  x and  z. 

The  space  orientation  of  the  inertial  components  is  fixed, 
except  for  gyro  drift,  at  the  time  of  initial  platform  erection. 

The  approximate  orientation  of  the  accelerometers,  at  erection  time, 
is  z parallel  with  the  EPA,  y perpendicular  to  the  local  vertical 
and  X perpendicular  to  both. 

The  basic  computational  requirements  of  GEANS,  in  addition  to 
platform  sequencing,  initial  erection,  control,  and  Built-In-Test, 
are  those  required  for  alignment,  navigation,  and  attitude.  All 
functions  are  computed  using  a 32  Hertz  program  interrupt  as  the 
time  synchronization  signal.  The  basic  computation  cycle  rate  is 
8 HertZ’ al lowing  the  computation  to  be  distributed  over  4 subcycles 
per  major  cycle. 


Alignment,  since  the  operation  is  space  stabilized,  consists 
of  estimating  the  coordinate  transformation  matrix  which  relates  the 
inertial  component  directions  to  the  desired  coordinate  frame  at 
time  of  transition  from  the  alignment  mode  to  the  navigation  mode. 

To  account  for  earth's  motion  an  earth  model  is  used  to  provide 
ideal  accelerometer  outputs.  These  outputs  are  differenced  with 
the  actual,  smoothed,  accelerometer  outputs  to  produce  residual 
values. 
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These  residual  values  are  then  used  to  compute  an  improved 
estimate  of  the  transformation  matrix  by  a minimum  least  squares 
technique. 

Successive  applications  of  this  process  are  required  to  achieve 
an  alignment  accuracy  commensurate  with  the  quality  of  the  inertial 
components  and  the  specified  performance  of  the  GEANS.  To  insure 
that  algorithm  errors  do  not  degrade  the  performance  of  which  the 
GEANS  equipment  is  capable,  the  algorithm  accuracy  requirement  was 
established  during  GEANS  development  to  be  1 second  of  arc.  This 
limit  was  then  used  during  analysis  to  establish  the  sophistication 
and  complexity  of  the  various  algorithms  required.  It  is  not 
possible,  however,  to  prove  that  this  accuracy  is  actually  attained. 

Navigation  computations  are  straight-forward  although  unusual 
because  of  the  space  stabilized  coordinate  frame.  The  special 
computational  requirements  stem  primarily  from  the  necessity  of 
providing  a very  accurate  gravity  model  and  from  the  necessity  of 
maintaining  position  preciseness  of  200  ft  in  a total  position 
magnitude  approximating  the  radius  of  the  earth  (2  x 10^  ft). 

The  basic  numerical  integration  time  interval  used  in  the 
original  HDC-601  computer  program  and  maintained  in  the  SKC-2000 
conversion  is  1/8  second.  Rectangular  integration  is  used.  The 
computational  load  is  in  four  1/32-second  segments  using  a 32-Hertz 

fl 

interrupt  for  timing  synchronization.  Central  processor  loading  in 
the  HDC-601  is  approximately  70%. 


SECTION  III 


SYSTEM  OPERATION  AND  TEST  APPROACH 

The  basic  approach  to  the  software  conversion  and  test  was  to 
provide  for  parallel  operation  of  the  SKC-2000  containing  the  converted 
program  while  allowing  the  GEANS  to  operate  normally  under  the  HDC-601 
computer  control.  This  approach  was  adopted  because  it  allowed  direct 
comparison  of  outputs  based  on  inputs  known  to  be  identical  and  avoided 
risk  of  GEANS  hardware  damage  by  using  the  well -tested  HDC-601 
sequencing  and  Built-In-Test  program  functions. 

Once  synchronized,  time  recording  within  each  computer  allowed 
complete  correlation  of  output  data.  During  alignment  this  data  allowed 
comparison  of  the  results  of  each  successive  alignment  matrix  computation. 
During  navigation  position  and  velocity  errors  could  be  compared 
(typically  at  6-minute- real-time  intervals). 

The  arrangement  shown  by  Figure  1 then  allowed  the  GEANS  equipment 
to  operate  normally  through  start-up  and  platform  erection  and  into  the 
ground  alignment  and  navigation  modes.  The  start-up  and  erection  modes 
were  not  programmed  on  the  SKC-2000.  Instead,  arrangements  were  made 
to  synchronize  the  two  programs  (HDC-601  and  SKC-2000)  at  the  start  of 
alignment  utilizing  a common  32  Hertz  interrupt. 

The  SKC-2000  runs  in  synchronization  with  the  HDC-601  to  a tolerance 
of  one  32HZ  interrupt  time  interval.  This  is  accomplished  through  a 
SKC-2000  routine  called  CDU.  Both  computers  are  turned  on  and  the 


HDC-601  controls  spin  up  and  sequencing  ot  the  GEANS  IMU.  The  CDU 
routine  monitors  the  HDC-601  program  as  it  progresses  through  ALIGNMENT 
and  NAVIGATION.  When  the  HDC-601  goes  into  NAVIGATION , the  operator 
manually  puts  it  back  into  ALIGNMENT.  This  is  sensed  by  CDU  which 
then  initiates  ALIGNMENT  in  the  SKC-2000.  From  this  point  both 
computers  are  running  in  parallel.  These  steps  are  shown  graphically 
by  Figure  2, 

The  data  recording  function  provided  by  the  PDP-11  is  flexible 
and  during  debugging  provided  records  of  many  internal  variables  versus 
time.  The  usual  information  recorded,  however,  is  the  same  as  the 
standard  optimized  GEANS  hard  copy  output.  This  output  is  primarily 
successive  alignment  matrices  during  the  alignment  mode  and  position 
and  velocity  components  during  the  navigation  mode.  These  outputs 
are  rich  in  information  about  the  behavior  of  the  software,  particularly 
when  the  two  separate  computer  outputs  can  be  compared  when  it  is 
known  that  they  are  derived  from  identical  input  velocity  increment 
streams.  As  one  example  of  data  analysis, a separate  CDC  6600 
program  was  used  to  deduce  and  compare  the  gyro  drift  rate  compensation 
being  applied  by  the  two  programs. 

An  additional  important  capability  was  provided  by  the  equipment 
shown  by  Figure  3.  This  capability  is  that  of  operating  the  SKC-2000 
program  from  magnetic  tapes  containing  recorded  GEANS  velocity  increment 
data  and  HDC-601  output  results.  The  velocity  increment  data  is  in 
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HDC-601 


SKC-2000 


Figure  2.  Steps  to  Run  SKC-2000  in  Parallel  with  HDC-601 


AFAL-TR-77-8 
Volume  I 


Figure  3.  Steps  to  Run  SKC-2000  from  Data  Tape 
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the  form  of  1/8  second  sums.  Operation  is  somewhat  faster  than  real 

time.  The  capability  was  important  for  two  reasons.  Runs  could  be 

repeated,  and  the  tape  recordings  could  be  used  as  input  for  a CDC-6600 

FORTRAN  program  which  duplicated  the  SKC-2000  program.  The  ability  to 

run  the  same  program  with  identical  inputs  was  of  great  value  during  j 

debugging. 
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SECTION  IV 
PROGRAM  CONVERSION 

GENERAL 

There  are  several  starting  points  and  approaches  which  may  be 
used  to  convert  a reasonably  complex  computer  program  for  use  on 
another  computer.  Because  limited  resources  and  documentation  were 
available  for  the  HDC-601  SKC-2000  conversion  many  potential  problems 
were  avoided  by  adopting  the  following  two  ground  rules: 

1.  All  basic  cycles,  cycle  times,  and  sampling  rates  were 
retained  unchanged. 

2.  All  algorithms  except  mathematical  subroutines  were  adopted 
unchanged  at  a level  expressable  as  FORTRAN  statements. 

The  major  deviation  from  the  GEANS  HDC-601  software  implementation 
was  the  use  of  floating  point  arithmetic  in  the  SKC-2000  software.  The 
decision  to  use  floating  point  arithmetic  in  the  GEANS  SKC-2000  software 
implementation  was  based  on  the  following  considerations:  (1)  the  use 

of  floating  point  arithmetic  does  not  require  the  scaling  of  constants 
and  variables  in  the  coded  program,  (2)  the  use  of  floating  point 
arithmetic  significantly  reduced  the  time  required  to  debug  the  coded 
software,  (3)  the  execution  time  of  the  SKC-2000  floating  point  software 
does  not  exceed  the  execution  time  of  the  HDC-601  fixed  point  software, 
(4)  the  GEANS  SKC-2000  software  conversion  and  implementation  process 
could  be  completed  and  verified  with  less  manpower  and  in  a shorter 
time  span  if  floating  point  arithmetic  was  used. 
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Conversion  Approach 

Conversion  of  the  GEANS  software  was  accomplished  by  the  following 
steps: 

1.  Navigation  and  Alignment  flow  charts  were  developed  from  the 
HDC-601  GEANS  assembly  code  listings.  These  flow  charts  provided  an 
understanding  of  the  GEANS/HDC-601  software  implementation.  They  also 
were  used  to  determine  the  division  of  functions  used  to  satisfy  timing 
requirements,  and  they  proved  to  be  a useful  form  of  documentation  of 
the  HDC-601 /GEANS  software. 

2.  These  Navigation  and  Alignment  flow  charts  were  studied  for  an 
understanding  of  GEANS  and  they  were  modified  to  include  corrections  for 
such  things  as  HDC-601  code  being  interpretea  improperly  or  changes  made 
by  Honeywell  during  their  optimization  program. 

3.  The  Navigation  and  Alignment  programs  were  then  coded  in  FOCAP 
assembly  language  for  the  SKC-2000  computer,  using  the  flow  charts  as 
reference.  Each  routine  in  these  programs  was  coded  separately,  then 
run  on  the  SKC-2000  to  eliminate  bugs  caused  by  coding  errors.  This 
was  the  preliminary  debugging  phase.  After  this  debugging  phase  a 
flow  chart  of  the  routine  was  drawn  to  reflect  its  implementation  on 
the  SKC-2000. 

4.  When  the  complete  Alignment  and  Navigation  programs  had  been 
coded  an  extensive  number  of  timing  checks  were  done  on  each  routine  to 


determine  execution  time.  These  checks  were  done  under  worst  case 


program  were  written.  These  sub-executive  programs  provide  the 
proper  sequencing  of  the  four  separate  branches  of  Alignment  and 
Navigation.  Each  branch  is  executed  at  l/8Tsecond  intervals.  Thus, 
a knowledge  of  the  execution  time  of  the  routines  that  comprise  these 
programs  was  necessary  to  insure  that  each  branch  would  execute  within 
the  given  1/8-second  time  interval. 

5.  After  Alignment  and  Navigation  had  been  decoded,  the  GEANS 
real  time  routines  were  coded,  debugged,  and  flow  charted  in  the  same 
way. 

6.  While  the  GEANS  algorithms  were  being  converted  to  run  on  the 
SKC-2000  a parallel  effort  was  under  way  to  develop  a double  precision 
math  subroutine  library.  All  variables  and  constants  are  defined  within 
the  library  - there  are  no  external  references.  Thus,  the  subroutine 
library  can  be  used  in  other  programs  as  well  as  GEANS.  It  has  been 
supplied  to  the  COLLINS  RADIO  CORP.  for  use  in  the  GPS  program  and  the 
double  precision  multiply  and  divide  routines  have  been  supplied  to 
SOFTECH  for  inclusion  in  version  2 of  their  J3B  Compiler. 

7*  To  aid  in  the  accompanying  analytical  studies  and  to  provide 
a debugging  tool,  a CDC-6600  program  was  generated  which  duplicates 
the  functions  of  the  SKC-2000  program  at  FORTRAN  statement  level. 

This  program  proved  very  useful  and  is  available  for  GEANS  error 
modeling  and  simulation. 
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Computer  Differences 


There  are  a number  of  differences  between  the  HDC-601  computer 

and  the  SKC-2000  computer  which  were  significant  in  performing  a 

software  conversion:  (1)  the  word  length  of  the  HDC-601  computer 

is  16  bits  single  precision,  31  bits  double  precision;  the  word  length 

of  the  SKC-2000  is  32  bits  single  precision  and  64  bits  double  precision, 

(2)  the  HDC-601  has  one  index  register;  the  SKC-2000  has  64  index 

registers,  (3)  the  SKC-2000  has  hardware  floating  point  capability; 

the  HDC-601  does  not,  and  (4)  the  HDC-601  has  approximately  80 

instructions;  the  SKC-2000  also  has  approximately  80  instructions; 

however,  these  instructions  are  in  general  not  compatible  on  a one-for- 

one  basis.  The  primary  characteristics  of  each  computer  are  shown  by 

Table  1.  TABLE  I 

COMPARISON  OF  SKC-2000  AND  HDC-601  COMPUTERS 
CHARACTERISTIC  SKC-2000  HDC-601 

Word  Length  32  16 


Registers 
Floating  Point 
No.  of  Instructions 
Double  Precision 

Multiplication  Time 


64 

Yes 

Approximately  80 
31  Bits  Fixed  Point 


lOps  for  Single 
Precision 
lOOps  for  Double 

Precision 


1 

No 

Approximately  80 

Up  to  56  Bits  Floating 
Point 

6ps  for  Single  Precision; 
75ps  for  Double 

Precision 


Accuracy  Considerations 


To  attain  the  computational  accuracy  of  the  GEANS  software, 
approximately  90%  of  the  navigation  and  alignment  algorithm  was 
coded  in  double  precision  on  the  HDC-601.  This  significantly 
affected  the  execution  time  of  a multiplication  or  a division 
operation.  For  example,  a fixed  point  single  precision  multipli- 
cation on  the  HDC-601  requires  approximately  10  microseconds  while 
a fixed  point  double  precision  multiplication  requires  approximately 
75  microseconds.  As  multiplication  is  the  single  most  often 
performed  operation,  this  differential  is  a significant  factor  in 
program  execution  time. 

The  word  length  of  the  SKC-2000  is  32  bits  which  is  double  the 
HDC-601  bit  word  length.  The  use  of  floating  point  arithmetic  on 
the  SKC-2000  requires  9 bits  to  define  the  sign  and  exponent.  Thus, 
only  23  bits  are  available  for  the  data  word.  In  contrast,  the  use 
of  fixed  point  arithmetic  on  the  HDC-601  requires  1 bit  to  define 
the  sign  and  thus  effectively  31  bits  are  available  for  the  data 
word.  Therefore,  to  retain  the  same  bit  accuracy  on  the  SKC-2000 
using  floating  point  arithmetic  as  is  achieved  using  double  precision 
fixed  point  arithmetic  on  the  HDC-601  required  the  use  of  double 
precision.  Because  of  the  64  bit  double  precision  word  length  of 
the  SKC-2000,  effectively  56  bits  are  available  for  the  data  word 
and  an  additional  24  bits  of  accuracy  can  be  achieved. 
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SECTION  V 

INTERFACE  HARDWARE  (SPECIAL  ELECTRONICS  ASSEMBLY) 

The  acquisition  of  IMU  output  data  from  the  GEANS  data  bus 
required  provision  of  a Direct  Memory  Access  (DMA)  Serial  Interface 
for  the  SKC-2000  computer  compatible  with  the  GEANS  System  Duplex 
Seiial  Data  Bus. 

After  consultation  with  Singer-Kearfott  Division  of  Singer,  Inc., 
manufacturers  of  the  SKC-2000,  the  selected  approach  was  to  install 
a Parallel  DMA  Input/Output  Channel  (PIOC)  (similar  to  that  used  on 
the  B1  type  (SKC-2070)  into  the  SKC-2000  Input/Output  Unit  at  the 
Singer-Kearfott  Plant.  The  Parallel  DMA  Channel  then  became  the 
driver  for  a Serial  Conversion  Board  (SCB)  designed,  constructed, 
and  installed  into  the  SKC-2000  I/O  Unit  by  AFAL/RWA.  The  SCB  does 
the  data  format  conversions  between  the  GEANS  Serial  Format,  a format 
acceptable  by  the  ports  of  the  PIOC  which  does  the  DMA  transfers  with 
SKC-2000  core  memory. 

INTERFACE  OPERATION 

The  Parallel  Output  Channel  (POC),  when  issued  a software 
command,  accesses  a control  word  specifying  an  external  device 
address,  word  count,  and  a data  block  start  address.  The 
first  data  word  is  then  accessed  and  transferred  to  the  SCB  in  two 
16-bit  halves.  The  SCB  reassembles  the  word  and  transmit  it  in 
serial  format.  During  the  serial  transmission  the  POC  is  accessing 
the  next  data  word  for  transfer  to  the  SCB.  This  continues  until 
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the  data  block  word-count  is  exhausted  and  the  POC  generates  an 
End-of-Transfer  Status  Bit  and/or  program  interrupt. 

The  Parallel  Input  Channel  (PIC),  when  issued  a software  command, 
accepts  external  input  requests  from  the  SCB.  After  the  SCB  has 
received  a serial  data  word  and  converted  it  into  parallel  format, 
it  generates  an  external  input  request  to  the  PIC.  The  PIC  then 
accesses  its  control  word  and  accepts  the  input  data  in  two  16-bit 
halves.  The  SCB  can  then  receive  the  next  serial  input  while  the  PIC 
is  storing  its  word  in  core  memory.  After  the  PIC  control  word 
word-count  is  exhausted,  the  PIC  generates  an  End-of-Transfer  status 
Bit  and/or  program  interrupt. 

An  additional  feature  of  the  SCB  is  that  one  of  the  output 
external  device  address  discretes  allows  the  POC  to  generate  a program 
controlled  reset  to  the  SCB.  After  either  a system  master  reset  or 
program  controlled  SCB  reset,  the  SCB  input  channel  ignores  all 
external  activity  until  after  the  SCB  output  channel  has  serially 
transmitted  one  word  which  is  simultaneously  routed  into  the  SCB 
input  channel  to  act  as  a frame  marker  and  interface  self-test 
word.  The  SCB  also  buffers  the  GEANS  32-Hertz  Clock  into  an  SKC-2000 
program  interrupt  input  to  act  as  software  and  input/output 
synchronizer  for  the  SKC-2000. 

The  particular  construction  selected  for  the  GEANS  Interface 
allowed  the  input/output  software  driver  to  be  modular  and  entirely 
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interrupt  driven  which  reduced  the  complexity  of  the  SKC-2000  GEANS 
Executive  Software.  The  actual  interrupt  driver  routines  totaled 
approximately  160  words  of  core  program  instructions. 

Further  details  of  this  interface  are  supplied  in  design 
documentation  available  from  the  Air  Force  Avionics  Laboratory, 
AFAL/RWA-4,  Wright-Patterson  AFB,  Ohio. 
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SECTION  VI 
MATHEMATICAL  MODEL 

The  software  conversion  was  not  a direct  instruction  by  instruction 
translation  because  of  fundamental  differences  between  the  machines.  In 
addition,  there  was  no  provision  for  continuous  Honeywell  analytical 
support.  For  these  reasons, it  was  necessary  to  develop  a thorough 
understanding  of  the  theory  of  operation  of  the  GEANS  alignment  and 
navigation  programs,  and  to  provide  a basic  mathematical  model  for  use 
at  the  AFAL. 

This  was  accomplished  by  a review  of  all  available  technical  informa- 
tion and  the  rederivation  of  some  basic  equations,  in  particular  the 
classic  least  squares  fine  alignment  approach.  An  extract  of  the  basic 
mathematical  background  information  was  prepared  and  can  be  found  in 
Appendix  A. 
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SECTION  VII 


CDC  6600  SIMULATION 

An  aid  which  was  decided  upon  very  early  in  the  task  effort  and 
which  was  found  to  be  extremely  useful  during  all  phases  was  a CDC  6600 
program  written  in  FORTRAN-IV.  This  program  does  not  simulate  the 
decoding  of  the  time  division  multiplex  data  from  the  GEANS  Inertial 
Measuring  Unit,  but  instead  operates  from  1/8  second  sums  of  velocity 
increments  from  a magnetic  tape.  All  of  the  alignment  and  navigation 
calculations  are  duplicated  at  statement  level. 

No  attempt  was  made  to  change  word  length  or  other  machine 
characteristics  to  resemble  the  SKC  2000  or  HDC-601 . The  full  word 
length  of  the  CDC  6600  was  used, as  were  the  CDC  6600  system  mathematical 
functions.  The  CDC  6600  number  processing  was  therefore  generally  more 
precise  than  the  SKC-2000.  This  difference  was  itself  a useful  attribute 
because  it  allowed  immediate  evaluation  of  whether  or  not  an  error 
appearing  in  the  SKC-2000  program  was  due  to  accumulated  computational 
errors. 

The  computational  flow  charts  of  the  CDC  6600  and  SKC  2000  are 
identical  for  those  program  segments  which  are  duplicated  by  the 
CDC-6600  program. 

Since  the  CDC  6600  programming  task  was  much  less  complex  than  that 
for  the  SKC-2000,  the  FORTRAN  program  preceded  the  SKC-2000  program 
during  all  of  the  software  development.  The  availability  of  this 
program  made  possible  the  discovery  of  many  errors  early  in  the 
programming  task  and  reduced  the  final  SKC-2000  debugging  task  to 
primarily  that  of  isolating  and  removing  errors  in  the  input 
decoding  process. 
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SECTION  VIII 


TEST  RESULTS 

Comparative  testing  of  the  GEANS  HDC-601  software  versus  the  converted 
SKC-2000  software  was  conducted  by  synchronizing  the  two  programs  after 
erection  of  the  platform.  The  input  velocity  increments  to  the  two  programs 
were  thus  identical  except  for  a possible  time  shift  of  up  to  1/32  second. 

After  transition  into  the  Navigation  Mode  position  output  versus 
time  was  recorded  for  each  computer  and  the  difference  between  the  two 
outputs  computed.  This  output  difference  is  shown  by  the  graphs  on  the 
following  pages. 

As  can  be  seen  from  Figures  4 through  8,  the  difference  between 
the  two  outputs  was  generally  0.015  nautical  miles  per  hour  or  about 
one  tenth  the  system  accuracy  specification.  This  performance  met 
the  conversion  project  objectives. 

The  form  of  the  plotted  curves  suggests  that  the  difference  between 
the  two  outputs  is  caused  by  an  effective  gyro  drift  rate  difference. 

Since  the  acceleration  inputs  are  from  the  same  platform,  such  a differ- 
ence would  have  to  be  due  to  a difference  in  the  gyro  drift  rate 
compensation  computations. 

The  computations  are  accomplished  by  subroutine  DC.  A rough 
analysis  showed  that  the  two  drift  compensation  calculations  can  differ 
enough  to  account  for  the  apparent  drift  rate  difference  but  the  analysis 
was  not  pursued  further  since  the  comparative  performance  met  project 
objectives. 
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SECTION  IX 
DISCUSSION 

The  GEANS  software  conversion  effort  consisted  of  the  conversion 
of  an  assembly  language  program  for  the  Honeywell  HDC-601  computer  to 
another  assembly  language  program  for  the  Singer/Kearfott  SKC-2000 
computer.  Since  the  architecture  of  the  two  machines  is  quite  different 
in  many  respects,  a one  for  one  instruction  translation  was  not  possible. 
The  more  powerful  features  of  the  SKC-2000  such  as  floating  point 
arithmetic  and  multiple  index  registers  were  taken  advantage  of  during 
the  conversion  process. 

The  GEANS  program  was  also  written  in  FORTRAN  for  the  AFAL  CDC-6600 
General  Purpose  computer  to  obtain  a thorough  understanding  of  the 
Alignment  and  Navigation  algorithms  involved  and  to  provide  comparative 
data  for  checkout.  Real  Inertial  Measurement  Unit  data  supplied  by 
Honeywell  on  magnetic  tape  was  used  as  input  for  both  the  CDC-6600  version 
and  SKC-2000  version  of  the  alignment  and  navigation  programs.  This 
provided  a high  degree  of  confidence  in  the  CDC-6600  program  because  of 
the  repeatability  of  the  input  data.  It  also  provided  a proven  tool  to 
debug  the  SKC-2000  program,  since  the  output  of  the  SKC-2000  program 
could  be  compared  to  the  output  of  the  CDC-6600  program.  Thus  a great 
deal  of  debugging  was  done  in  non- real  time. 

The  HDC-601  and  SKC-2LJ0  were  run  in  real  time  simultaneously. 

The  SKC-2000  real  time  executive  automatically  synchronized  with  the 
HDC-601  so  both  programs  ran  in  parallel,  using  the  same  input  data 
from  the  IMU.  Alignment  and  Navigation  output  of  both  programs  could 
then  be  compared,  and  the  SKC-2000  output  verified. 
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The  conversion  was  completed  successfully,  the  HDC-601  and 
SKC-2000  outputs  agreeing  to  about  0.015  nautical  miles  per  hour. 

The  program  was  shown  to  have  a small  degree  of  machine  and 
algorithm  dependency  but  that  this  dependency  causes  an  apparent  gyro 
drift  rate  change  of  less  than  one-tenth  of  that  allowable  by  specifica- 
tion and  has  negligible  effect  on  system  accuracy. 

The  program  conversion  reported  herein  was  from  assembly  language 
to  assembly  language.  Although  the  use  of  a Higher  Order  Language  (HOL) 
would  not  affect  accuracy  performance  significantly,  time  loading  and 
memory  requirements  might  change.  It  is  therefore  recommended  that 
portions  of  the  SKC-2000  program  be  converted  to  the  HOL  J3B  and  the 
time  and  memory  requirements  of  the  resulting  assembly  language  program 
be  compared  with  those  of  the  corresponding  program  segments  coded 
directly  in  assembly  language. 
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APPENDIX  A 

GEANS  MATHEMATICAL  BACKGROUND 

The  material  in  this  appendix  is  a short  summary  of  the  mathematical 
derivations  contained  in  the  program  documentation  generated  by  Honeywell 
Incorporated  under  USAF  contract  and  has  been  Included  in  this  report 
for  convenience.  For  a more  complete  treatment  the  Honeywell  report?* 
shotLld  be  consulted. 

COORDINATE  FRAI-IES 

The  coordinate  frames  shown  in  Figure  9 were  selected  for  GEANS. 

The  origins  of  all  coordinate  frames  are  located  at  the  center  of  the 
earth  and  are  portrayed  as  shown  for  convenience  only. 

(Xj,  Yj,  Zj)  is  the  inertial  frame  in  which  all  computations  are  performed. 
The  Zj  axis  is  parallel  to  the  earths  rotation  axis  and  Yj  points  east 
at  the  beginning  of  navigation. 

(Xjj,  Yj^,  Zj^)  is  a local  level  coordinate  frame  associated  with  the  position 

of  the  aircraft.  Y.,  points  east  and  Z„  points  north  at  all  times. 

N N 

(Xg,  Yg,  Zj,)  is  an  earth  fixed  coordinate  frame.  X^,  lies  along  the 
Greenwich  Meridian  and  Z lies  along  the  earths  rotation  axis. 

(Xp,  Yp,  Zp)  which  is  not  shown  is  the  platform  coordinate  axis  and  is 
aligned  with  the  accelerometer  triad. 

I 

(X-,  Y , Z_)  which  also  is  not  shown  is  the  gyro  coordinate  axis.  The 
G G r 

relationship  between  the  gyro  coordinate  axis  and  the  platform  axis  is 
defined  later. 

*Russ  Sittloh  et  al.,  "AN/ASN-101  Optimization  Program,"  Interim  Report 
AEAL-TR-20UR-IT-2 , Hone;fwell  Inc.,  St.  Petersboro,  Florida,  January  1973. 
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COORDINATE  TRANSFORMATIONS 

The  following  coordinate  transformations  are  readily  derived  from  Figure  9. 


cos  (A 
-sin( A 


0 

0 

0 


+ fit)  sinCAg  + fit)  0 

+ fit)  cos(Aq  + fit)  0 

0 1 


Aq  - initial  longitude 
fi  - earths  rotation  rate 

(1) 


COS0  cosA 
-sinA 

-sin0  cosA 


cosO  sinA 
cosA 

-sin0  sinA 


sinO 

0 

cosO 


0 - latitude 
A - longitude 

(2) 


0 

2 

v’2 

2 


1 

0 

0 


(3) 
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BASIC  NAVIGATION  EQUATIONS 

The  specific  force  equation  for  an  accelerometer  in  inertial  space  is 
vhere 

a^  - acceleration  of  the  point 
Gj  - gravitation  at  the  point 


This  equation 

can  he 

written  in  terms  of  inertial  velocity  as: 

^XI 

= ^XI 

*^XI 

(5) 

(6) 

= ^ZI 

"Si 

(7) 

The  calculation  of  inertial  position  from  inertial  velocity  can  he  determined 
as : 
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As  written  above,  these  mechanization  equations  are  unstable.  They  can 
be  stabilized  by  use  of  an  altimeter  as  follows: 


V *5 

M 

X 

> 

- K(R 

ec 

+ h - Rj)r^^ 

(11) 

11 

M 

- K(R 

ec 

+ h - Rjlr^j 

(12) 

11 

M 

- K(R 

ec 

+ h - Rj)r^j 

(13) 

To  obtain  stability  the  altimeter  must  also  be  used  in  the  computation  of 
the  gravity  components  in  Equations  5-7. 

PLATFORM  TO  COMPUTATION  FRAME  TRANSFORMATION 
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By  definition,  the  computation  frame  is  non-rotating  with  respect  to  inertial 
space.  It  is  assumed  in  the  sequel  that  the  rotation  of  the  platform 
coordinate  ceun  be  described  by  small  angular  rotations. 

An  arbitrary  vector  r can  be  expressed  in  the  two  frames  as : 


= c'’? 

IP 


(1»*) 
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GRAVITY  MODEL 

The  gravity  model  used  in  the  GEARS  Navigation  Software  is: 

= ^Ag*[A^-6  sin^0  + 9 sin^O]  + - A^P^  (A^  - sin^0)'jrj^j 

Gyi  = |Ag*[A^-6  sin^0  + 9 sin^0]  + A^P^  - A^P^  (A^  - sin^Gljr^j 

G„^  = Ta  *[A^  + A_  - 10  sin^0  + 9 sin**0]  + A^P^  - A P''  (A„  + A.  - sin^0 
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vhere 


P = 1 _ ^ + (M)2 

R ^ r' 

(28) 

AR  = h - [21385  sin^e  (l.  + O.OO5O3  cos^O  )] 

(29) 

Aq  = -1. 5362271 37E-6 

(30) 

A^  = 1.21<7*<33376E-8 

(31) 

Ag  = -I.593661308E-II 

(32) 

A^  = 0.2 

(33) 

A^  = 0.1. 

(3l<) 

A,,  * 0.1»285711»286 

(35) 

k(-  = 1.71  *<28571 

(36) 

LATITUDE,  LONGITUDE  CALCULATION 

From  Figure  9 , the  computation  of  latitude  and  longitude  can  be  readily 
derived  as : 

0 = Oq  + tan 


(37) 


AFAL-TR-77-8 
Volume  I 


-1  Ti 


A = Ap-^+tan 


LOCAL-LEXTL  VELOCITY  COMPUTATION 


The  relationship  of  the  radius  vector  in  the  computational  and  earth  fixed 
coordinates  frames  can  be  expressed  as: 


V - 

I “ “IE 


and  the  time  derivations  as: 


**E  " S**!  " 


C^r  = r - C^C^r 

E N I ‘^I^E  I 


The  expression  %?£  is  the  velocity  with  respect  to  the  earth  expressed 
in  local-level  coordinates  and  can  be  written  as: 


INTEGRATION 

Euler  integration  is  used  in  the  GEANS  Mechnaization.  This  can  be  expressed  as: 


X(t  + At)  = X(t)  + f(x(t),  t)  At 


for  the  differential  equation 


X(t)  = f(X(t),  t) 


The  accelerometers  used  in  the  GEAKS  platfo_rm  are  really  velocity  meters 
and  their  output  is  a change  in  velocity  AV^.  over  a specified  time 
interval  At.  Thus  the  average  acceleration  over  the  time  period  At  is 


^ At 

Thus,  the  mechanization  equations  5-7»  and  11-13  can  be  written  as: 


r^(t+At)  = rj^j(t)+V^(t)At  f K(Rgp+h(t)  - R^)  r^j(t)  (><7) 

ryj(t+At)  = ryj(t)+Vyj(t)At  f K{R^p+h(t)  - R^)  ry^(t)  (l^S) 

r2j(t+At)  = r2j(t)+V2j.(t)At  f K(R^p+h(t)  - R^)  r^jd)  (1<9) 

Vj^(t+At)  = Vj^(t)  + AV^  + G^At  (50) 

Vyj(t+At)  = Vyj(t)  + AV^j  + GyjAt  (51) 

(52) 


The  accelerometer  error  model  as: 


AV 
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The  gyro  error  model  as: 


(53) 
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(55) 


Note  that  since  C_  is  continually  updated  <J)  (t),  (J)  (t),  (j>  (t)  = 0. 
The  platform  to  computation  frame  transformation  is  computed  as: 


Cj  (t+  At)  = Cj  (t)  + Cj  (t)  (P,  I)  At 

(t+  At)  = Cj  (t)  + Cj  (t)A(t) 


(56) 

(57) 


vhere 


0 


-(Ji 

0 4> 

0 


(58) 
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APPENDIX  B 


PROGRAM  ORGANIZATION  AND  FLOW  CHARTS 
SKC-2000  PROGRAM  ORGANIZATION 

The  organization  of  the  converted  program  for  use  by  the 
SKC-2000  computer,  which  follows  closely  that  of  the  original 
HDC-601  computer  program,  is  described  below  and  is  shown  graphically 
by  the  flow  charts  (Pages  62  through  120)  of  this  appendix.  The  software 
is  divided  into  5 decks.  These  decks  are: 

NAV  - navigation,  which  includes  all  navigation  subroutines 
plus  drift  computation  and  the  navigation  data  base. 

SUBLIB  - the  math  subroutine  package 

INIT  - navigation  and  alionment  initialization  routines  and 
their  data  base. 

ALIGN  - alignment  subroutines  plus  data  base 

RTEXEC  - real  time  executive  and  real  time  routines  plus  data  base 

The  data  base  in  each  deck  is  organized  into  common  data  blocks, 
a local  variable  area,  and  a local  constants  area.  The  common  blocks 
include  one  universal  variables  common  data  area.  This  includes  all 
variables  common  to  all  decks.  There  is  one  universal  constant 
common  area.  In  addition  each  deck  has  common  areas  for  data  it 
shares  with  other  decks  but  may  not  share  with  all  decks.  A brief 
description  follows: 

1.  WLDCOM  - GEANS  world  variable  data.  Contains  all  variables 
used  throughout  GEANS. 
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2.  NIACOM  - NAV,  INIT,  and  ALIGN  variables.  Contains  those  variable 
used  in  navigation,  initialization  and  alignment. 

3.  NICOM  - NAV  and  INIT  variable  data.  Contains  variables  used  in 
navigation  and  initialization. 

4.  MATCOM  - world  matrix  and  miscellaneous  data.  Most  matrices, 
vectors,  and  some  miscellaneous  data  resides  here. 

5.  CONCOM  - GEANS  world  constants.  All  universial  constants  and 
system  calibration  data  are  in  this  COMMON. 

6.  lACOM  - Init  and  ALIGN  variables  data  area.  Variables  common 
to  initialization  and  alignment. 

NAVIGATION 

The  SKC-2000  GEANS  navigation  program  consists  of  four  branches, 
each  branch  being  executed  at  1/8- second  intervals.  The  navigation 
scheduler,  NSCH  controls  the  selection  of  branches.  This  program 
starts  out  with  subroutine  lA,  the  sub-executive  for  navigation. 

This  routine  does  the  actual  scheduling  of  branching  and  subroutine 
calls.  A description  of  subroutines,  branch  by  branch,  follows. 

Branch  1 : 

IC  - computes  accelerometer  bias  and  scale  factor.  Also  compensates 
for  non-orthogonality  between  the  accelerometer  coordinate 
frame  and  the  actual  physical  mounts. 
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ID  - rotates  acceleration  vector  from  platform  reference  frame  to 
navigation  reference  frame. 

IE  - computation  of  the  gravity  vector  for  the  present  position. 

1 

IF  - computes  earth  raduis  and  delta  radius.  Computes  vertical 
damping  vector 

IG  - Double  integration  for  velocity  and  distance. 

Branch  2: 

IH  - Latitude  and  longitude  computation 

IJ  - computation  of  velocity  in  local  vertical  co-ordinates,  ground 
speed,  and  earth  relative  velocity.  Also  computes  the  position 
update  matrix,  VI. 


Branch  3; 

NAVO  - navigation  output  routine.  Outputs  navigation  variables  to  a 
buffer  when  they  are  accessed  by  the  PDP-11.  Output  occurs 
at  0.1  hour  intervals. 

Branch  4: 

IL  - drift  compensation  computation.  This  routine  is  executed  once 
per  second.  It  constructs  an  update  matrix,  DCAR.  Execution 
period  is  controlled  by  variable  DCON. 

IM  - this  routine  updates  the  AJ  matrix  using  update  matrix  DCAR. 

It  compensates  the  AJ  matrix  for  gyro  drift.  This  occurs  at 
one  second  intervals.  Saves  present  AJ  in  matrix  SA. 
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RIAL  - this  is  the  return  to  alignment  decision  routine.  If  the 
software  MODE  switch  is  - 4 subroutine  PENT  is  called  and 
the  system  returns  to  Alignment.  If  MODE  is <4  the  system 
remains  in  navigation. 

ALIGNMENT 

The  SKC-2000  GEANS  alignment  program,  like  the  navigation 
program,  contains  four  branches.  It  is  controlled  by  the  alignment 
scheduler,  ASCH,  and  starts  with  the  alignment  sub-executive  IIA 
which  does  the  same  type  of  scheduling  that  the  navigation  sub- 
executive does.  A description  of  the  branches  and  subroutines 
f ol 1 ows : 

Branch  1 : 

lie  - this  is  subroutine  IC  in  navigation  - computes  accelerometer 
bias  and  scale  factor,  and  accelerometer  non-orthogonality 
compensation. 

IID  - this  routine  calculates  the  filtered  values  of  the  delta  Vs 
which  are  used  in  the  alignment  solution.  Both  coarse  and 
fine  filter  values  are  calculated  until  NMO  >7.  After  NMO 
is  >7  the  coarse  filter  values  are  no  longer  calculated. 

HE  - this  is  subroutine  ID  in  navigation  (see  above). 

Branch  2: 

IIP  - drift  compensation  computation  (subroutine  IL  in  navigation). 
It  is  executed  once  per  second  as  in  navigation. 
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Branch  3: 

IIG  - subroutine  IM  in  navigation.  Also  executed  once  per  second, 
as  in  navigation. 

IIH  - This  routine  calculates  reference  delta  Vs  RDVX,  RDVY  and  RDVZ. 

It  then  does  residual  summing. 

IIK  - computes  earth  polar  axis  (ERA)  solution 

IIM  - solves  for  local  level  alignment  about  north  without  attempting 
to  correct  for  azimuth  error. 

IIO  - least  squares  solution.  The  intermediate  step  in  solving 
for  the  final  alignment  correction  angles. 

IIP  - Computes  the  AJ  matrix  with  corrections  about  X,  Y,  and  Z 
as  computed  in  each  of  the  alignment  modes,  and  with  a 
rotation  about  Z for  earth  movement  since  the  previous  update. 
ALNO  - Navigation  output  routine. 

Branch  4; 

HR  - Go  to  nav  decision.  This  routine  is  executed  once  every  1/8 
second.  The  criteria  for  entering  navigation  are  as  follows: 

1.  Navigation  mode  is  selected 

2.  Fine  alignment  must  be  complete  (NM0.GE.8). 

INITIALIZATION 

The  deck  called  INIT  contains  the  following  initialization 
routines. 
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PENT  - First  entry.  This  routine  initial  system  variables  for 
alignment  and  drift  computation.  It  loads  a call  to  the 
alignment  sub-executive  in  the  vector  table  of  the  executive 

NAVI  - Navigation  initialization.  Also  replaces  VECT  align  call 
with  call  to  Nav. 

RSET  - Selects  solution  time  and  made  for  alignment.  Alignment 
solution  cycle  counter  vs  mode  number  (NMO). 

RTEXEC  - Contains  the  following  routines: 

EXEC  - this  is  a initialization  routine  used  to  clear  the  real  time 
status  of  the  SKC  2000  and  reset  the  DMA  input  and  output 
channels.  Initialization  is  then  followed  by  the  real  time 
executive.  It  is  originated  at  7800.|g  and  is  entered 
automatically  when  the  SKC-2000  is  reset  and  set  to  RUN. 

CDUI  - initializes  routine  CDU 

BDSI  - initializes  routine  DECODE  (DECD) 

CDU  - synchronizes  the  SKC-2000  alignment  program  with  the  HDC-601 . 
INTIO  - interrupt  10  (32  HZ  interrupt)  processing  routine. 

INT05  - interrupt  5 (DMA  input  complete)  processing  routine. 

INT04  - interrupt  4 (DMA  output  complete)  processing  routine 
DECD  - unpacks  SIDE  words  and  stores  them  for  use  by  other 

programs.  Repacks  BITE  bits  for  use  by  the  BITE  routine. 
Diagnostic  checks  are  used  for  verification  of  rotor  speed 


OUTPUT  DATA  FOR  ALIGNMENT  AND  NAVIGATION 

Standard 

The  standard  output  is  designed  for  use  v/hen  routine,  record 
runs  are  made  and  provides  sufficient  information  for  evaluation 
of  performance  and  some,  minimum,  debugging.  The  output  is  similar 
to  that  of  the  Honeywell  601  during  alignment  and  navigation. 

Standard  - Alignment 

The  output  during  alignment  is  only  at  the  end  of  each  alignment 
calculation,  that  is  each  AJ  update  as  the  result  of  Least  Squares 
Solutions  and  the  preceding  AJ  revisions.  The  outputs  are  recorded 
on  tape  for  subsequent  generation  of  hard  copy  and  are  displayed  on 
the  CRT  until  the  next  AJ  update.  Drift  correction  of  AJ  is  not 
regarded  as  an  AJ  update.  The  first  two  updates  are  1 second  apart, 
the  next  three  are  8 seconds  apart  and  the  remainder  are  150  seconds 
or  more  apart.  The  quantities  displayed  are  Time,  NMO,  SX,  SY,  SZ, 
and  the  sine  elements  of  AJ  row  major.  The  format  is  4E15.8 

Units  are  not  a problem  for  this  output  form  since  all  quantities 
involved  are  unitless. 

Standard  - Navigation 

Upon  and  after  beginning  of  navigation  the  quantities  listed 
below  are  acquired  every  AT  where  AT  is  a nominal  value  of  360  seconds. 

The  data  are  recorded  on  tape  for  possible  subsequent  generation 
of  hard  copy  or  punched  cards  and  is  displayed  on  the  CRT  until  the 
next  observation  time. 


The  items  listed  are  not  exactly  those  of  the  Honeywell  601. 

The  quantities  are  also  not  all  directly  available  from  SKC  2000 
storage  in  the  form  desired.  Necessary  processing  is  indicated  below, 
and  is  done  by  the  PDP-11/40  data  acquisition  program  RGATTY. 

Table  1 lists  data  displayed  and  the  process  by  which  it  is  derived. 

MATH  SUBROUTINE  LIBRARY 

The  GEANS  math  subroutine  library  is  written  to  handle  double 
precision  arguments.  It  is  completely  self  contained.  That  is,  all 
constants  and  variables  are  contained  within  the  same  deck  - there  are 
no  external  references.  Temporary  storage  is  handled  with  a push-down 
stack,  with  the  address  of  the  stack  in  index  register  6.  The  stack 
is  located  in  LSI  memory  for  maximum  speed  of  execution.  The  library 
contains  the  following  math  subroutines:  SINCOS  (sine  and  cosine), 

DECSQ  (square  root),  DECATN  (arc  tangent),  MULFD  (double  precision 
multiply),  DVFD  (double  precision  divide),  and  EXP  (exponential). 

It  also  contains  a 3 x 1 vector  add  a 3 x 1 vector  subtract  routine 
(VECADD  & VECSUB),  a 3 x 3 matrix  add  routine  (MATDAD)  a 3 x 3 single 
precision  matrix  multiply  routine  (MULS33) , a 3 x 3 double  precision 
matrix  multiply  routine  (MUL33),  and  a (3  x 3)  (3x1)  vector  multiply 
routine  (MULD31). 

All  vector  operations  are  limited  to  3 x 1 vectors  and  all  matrix 
operations  are  limited  to  3 x 3 operations.  Since  GEANS  Alignment  and 
Navigation  are  limited  to  operations  on  vectors  of  these  dimensions  it 
was  decided  not  to  write  generalized  matrix  handling  routines. 
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TABLE  1 

STANDARD  NAVIGATIDN  OUTPUT 

ITEM  I 

SKC  2000 

, OUTPUT  , 

FORM 

FORM 

PROCESS 

E SECONDS  I MINUTES 

SINCE 
ORIGIN 

DELTA  LAT  LATITUDE  IN  I DELTA  LAT 

TT  RADIANS 

DELTA  LONG  LONGITUDE  IN  I DELTA  LONG 
71  RADIANS 


(TIME-TIME  IN  NAV)/60.0 


(LATITUDE-LOADED  LAT)*tt 
*57.295*6D.D 

(LDNGITUDE-(LDADED  LONG*COS 
(LDADED  LONG)))  *77*57.295*60.0 
1 

[(ALAT)2  + (along) 
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The  math  subroutine  library  has  been  optimized  and  contains  a 
short  instruction  density  of  66%.  This  can  be  improved  somewhat  by 
further  optimization  of  the  code.  This  library  can  be  included  in 
any  program  that  requires  use  of  double  precision  arithmetic. 

Each  routine  has  a temporary  storage  area  that  contains  as  many 
words  as  the  routine  needs,  including  one  word  for  the  return  address. 
The  return  address  is  at  the  top  of  the  stack.  Upon  entry  the  contents 
of  XR6  is  decremented  the  number  of  full  words  necessary  for  temporary 
storage.  Before  the  return  XR6  is  incremented  the  same  number  of  words. 
All  routines  are  re-entrant. 


SINCOS  - This  routine  computes  both  the  sine  and  cosine  of  the  argument 
passed  to  it.  It  also  assumes  the  argument  it  receives  is  in  u radians. 

The  sine  function  F(x)  - Sin  x is  evaluated  by  the  modified  Taylor 
expansion; 

5 

Sin  -2-  X = 02,^+^  X , where  | x | 1 1 

K=0 

This  apprbximation  gives  a relative  error  less  than  .5  x 10  , the 

maximum  occurring  near  X=l.  So  the  error  in  Sin  X does  not  exceed 
.5  X 10'^. 
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For  the  sine  function  f(y)  = Sin  y to  operate  it  is  necessary  to 


reduce  y to  the  interval 


TT  TT 1 

2’  2j  • 


Then:  Sin  y = Sin  (if-y) 

Sin  y = Sin  (y-2ir) 


To  do  this  form  two  parts:  n = yj  (integer  part) 

and  f = ■ -Syl  (fractional  part).  The  two  low  order  hits  of  n,h.  h 

TT  j ° 

indicate  what  quadrant  y is  in.  Let  m - hj  h^.  The  table  below  gives 
the  quadrant  as  a function  of  m. 


m (binary)  Quadrant  Y~^  = Y modulo  2tt 

00  1 [e  0^.|) 

01  2 ttJ 

10  3 l^e  TT, 

11  1^.  2-nj 

With  the  quadrant  known  approximate  identities  can  be  used  to  express 
Sin  y as  a function  of  a modified  argument  x » g (f)  where  x e [0,l] 


Quadrant 


then  set  x 


usinK  the  identit 


Sin  (-  (y 


Sin  (-  (2tt 
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For  any  y,  y^  = y modulo  2tt  = m |-  + 1 the  constants  are  as  follows: 

1.57079673 

Og  - .61*5961*86 

.079692215 
- .001*6761082 
.00015209895 


DECSQ  - returns  the  square  root  of  the  argument  passed  to  it. 
A floating  point  numiber  can  always  be  written  in  the  form 


m.2  if  the  exponent  is  even 

^ = 2k 

m.2  .2  if  the  exponent  is  odd 

where  .5-  |m|  1 and  k=0,-l,-2,  ... 


Thus  the  square  root  is 


1)  yic  = 


2 * if  the  exponent  is  even 

2^  ' ./m  ' y/2  if  the  exponent  is  odd 


To  calculate  the  square  root  Heron's  iterative  process  is  used.  An 
initial  approximation,  y^,  to  is  made.  Then  the  recursive  values 


are  computed. 


1 j Y.  + 2_  I 


, (i  = 0,  1,  2,  ...)  until 


is  such  that  the  discrepency  is  invisible  to  the  machine: 
I V /TT  I < _ < 0-31 


Y„  n-  e"-  2' 


yx  - 4,.  “ 
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The  initial  approximation  for  is : 

.5826924  M + .41730760  on  the  interval  [,5,  l] 

Once  y is  obtained  three  iterations  are  required  to  obtain  th^n  ,Jx 

■'  o 

is  calculated  using  equation  1. 

DECATN  - returnsTAN  ^ (Y/X)  in  it  radians. 

Let  U = Y/X.  The  algorith  used  to  evaluate  tan  ^X  (arctan  X) 
is  only  valid  for  X e (0,  l),  so  it  is  necessary  to  reduce  X to 
that  interval.  This  is  done  by  using  the  identities: 


tan  ^ 

(-X) 

= - tan"^  (X) 

when 

X<  0 

tan  ^ 

(0) 

= 0 

when 

X = 0 

, -1 
tan 

(X) 

- tan  ^ (X) 

when 

0'^-  X 

. -1 
tan 

(X) 

= 1 - tan-^  (i) 

when 

X > 1 

Thus  tan~^X  can  be  expressed  in  terms  of  a tan  ^Y  where 
Y = g (X)  = X or  i 

Now  if  0<  Y 1 the  following  algorithm  is  used: 
tan  ^ Y = tan  ^ Z + C 

where : 

Iif  X < 2 - ,,/T  then  Z = X and  C = d 
if  X i g 

X + yj 
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“2k+l  ^ 


The  constants  follows: 


.99999999981* 


Og  -.3333328936 
.19996531*78 
-.11*1731*6061 
.091*91951*95 


MULFD  - returns  a double  precision  (-  1*6  bits  of  accuracy)  product  of 
two  input  arguments. 

Algorithm  is  multiplication  by  parts: 


P = X * Y 


where 


^ = ^A  " 


P«„  = * Yt, 

AB  A B 


Pt,.  = * 7, 

BA  3 / 


P.«  = * 7„ 

AA  A A 


P = P.„  + Pr,.  + P.A  where  P = P + e 
AB  BA  AA 


and  e ^ P * 2 approximately 


4 « > .ii 


= ^ , TT-%  . 
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DVFD  - returns  a double  precision  (-I42  bits  of  accuracy)  quotient  of 
two  input  arguments . 

Algorithm  is  recursive  division 
Q=i 


Qi  = Da  d 


= d - D 


% °A  ^1 


= Qj  + Q2  where  = Q + E 

< -h2 

and  E - Q » 2 ^ 


EXP  - this  routine  is  part  of  this  library  although  it  is  not  utilized 
in  the  GEANS  program. 

To  calculate  the  exponential  function 
f(x)  = 

Cody  and  Ralston's  algorithm  is  used.  This  is  as  follows: 

Set  X E ( - «,  <») 


gX  ^ 2®  = 2^  logp® 


Set  n = [X  log^  e]  (integer  part)  and 

r = { X log^  e)  (fractional  part) . Then 


4 
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= 2"  2^,  |r|  <1 


Now 


_r  1 2 r-ln2 
2 = e n = e 


Define  Y = . Then  Y e 

2 


r-ln2  ln2l 

[2*2] 


On  this  interval  the  approximate  to 


(e^  = 


1 + 


2Y 
A^-y-Ai 


B^■^Y 


is  nearly  the  best  (in  Chebyschev's  sense)  which  has  a relative  error 

-9 

of  less  than  10 
where : 


A = 12.015016753875 

o 

A^  = 601.801*2666979565 
= 60.090190731926 


FLOW  CHARTS 

The  charts  on  the  following  pages  reflect  the  converted  SKC-2000 
program  in  its  final  form. 


i 

I 
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DV  FILTERING 


GEANS  NAVIGATION 
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E.P.A.  SOLUTION 


IIK 

IIK2 


TEM2  = VAX/AK1T 
TEMO  = VAY/AK1T 


SWT  = TEM0/SQRT(TEM0**2+TEM2**2) 
CWT  = TEM2/SQRT(TEMO**2+TEM2**2) 
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LOCAL  LEVEL  SOLUTION 


AFAL-TR-77-8 
Volume  I 


GO  TO  NAV  DECISION 
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NAVIGATION  INITIALIZATION 


NAVI 
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NAVIGATION  SUB-EXECUTIVE 
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TURN  OFF  INS 
NOT  ALIGN  LIGHT 
(NOT  IMPLEMENTED) 
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Vector  Table 


During  Alignment 


VECT 


CALL  DUMY 
CALL  DECD 
CALL  CDU 
CALL  ALIGN  (IIA) 
CALL  SPIN  (DUMY) 
CALL  DUMY 
CALL  BITE  (DUMY) 
CALL  DUMY 
CALL  DUMY 
CALL  DUMY 
CALL  DUMY 
CALL  DUMY 
CALL  DUMY 
CALL  GASC  (DUMY) 
GO  TO  Ex30A 


During  Navigation 
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CDU  Initialization 
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Initialize  Built-In  Test,  Data  Decode,  & Auto 
Sequencing. 


BDSI 
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04E  DATA  = R.A.T.  FIELD  (177)  & VERTICAL  VEL  FIELD  (122) 

\ 

04D  DATA  = ROTOR  SPEED  (177) 


05D  DATA  = R.A.T.  BITE  BIT  (177)  & TEMPERATURE  BITE  (174) 
& IMU  BITE  (173)  & DOPPLER  REL  BIT  (121) 

~ - ■ F - 

025  DATA  = BITE  BITS  (121)  & BARD  ALTITUDE  (025) 


I 060  DATA  = DRIFT  & HEADING  (122)' 


050  DATA  = -DVX  (176)  & +DVX  (175) 

051  DATA  = -DVY  (176)  & +DVY  (175) 

052  DATA  = -DVZ  (176)  & +DVZ  (175) 


BTEl  BITS  FOOOifi  = 05D  DATA  BITS  FOODie 


BTEl  BITS  OFFOifi  = OSD  DATA  BITS  OFFOir 
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INTERRUPT  4 ROUTINE 


INT  04 


^0  ^ \=0 
r<  EXN0 


Save 

S,A,B 

DPI 


Save  S Reset  Flag  1 


APPENDIX  C 


TIMING  DATA  FOR  PROGRAM  SEGMENTS 

The  following  table  gives  timing  data  on  the  GEANS  Alignment  and 
Navigation  routines  in  the  SKC-2000  computer.  A test  program  was 
written  in  which  a call  to  the  routine  under  test  was  made  repeatedly 
a fixed  number  of  times.  Then  the  actual  run  time  of  the  routine  was 
calculated  by  dividing  elapsed  time  by  the  number  of  executions. 
Elapsed  time  was  determined  by  counting  the  number  of  Sms  interrupts 
that  occurred  during  the  test.  The  test  was  repeated  several  times 
and  an  average  taken  for  the  final  result. 

Each  routine  in  the  math  subr-^utine  library  uses  a memory  stack 
to  store  temporary  variables  during  it's  execution.  The  timing  tests 
were  done  with  this  stack  resident  in  core  memory  and  in  LSI  (Large 
Scale  Integrated  circuit) 


memory. 


ROUTINE 


AVERAGE  EXECUTION  TIME 
IN  MILLISECONDS 


STACK  If;  CORE 

STACK  IN  1 

IC  (Accel  Bias  & Scale  Factor) 

1.733 

1 .436 

ID  (Transform  Accel  to  Gyro  Co-ordinates) 

1 .723 

1.44 

IE  (Gravity  Model) 

3.323 

2.737 

IF  (Vertical  Damping  & DR) 

1.125 

0.913 

IG  (Double  Integration  for  Position 

1.481 

1.253 

IH  (Lat  & Long  Computation) 

6.757 

5.509 

IJ  (Local  Level  Co-ordinates  & Ground  Speed) 

10.149 

8.484 

IL  (Drift  Compensation) 

12.673 

10.458 

IM  (Update  AS  & SA  Matricies) 

9.07 

7.283 

RTAL  (Return  to  Align  Decision) 

8.82 

7.54 

FENT  (First  Entry) 

8.446 

7.202 

I ID  (Low  Pass  Filter) 

4.425 

3.799 

IIH  (Reference  Profile) 

3.372 

2.76 

IIK  (EPA  Solution) 

1.824 

1.507 

IIM  (local  Level  Solution) 

1 .843 

1 .513 

I 10  (Least  Squares  Solution 

8.045 

6.575 

IIP  (Compute  AA  & AAJ  Matricies) 

19.613 

15.906 

HR  (Go  to  Nav  Decision) 

6.064 

5.142 

lA  (NAV  Sub-executive) 

Branch  1 

22.351 

17.781 

Branch  2 

28.351 

22.060 

Branch  3 

10.698 

14.246 

Branch  4 

27.692 

34.384 

IIA  (ALIGN  Sub-executive) 

Branch  1 

5.452 

4.494 

Branch  2 

11.649 

9.547 

Branch  3 

10.670 

8.70 

Branch  4 

9.077 

7.496 
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